APPENDIX A 



% BEGINNING OF PSEUDO CODE 

5 % compute scale factor A, and time constants a, b from physical system 

% parameters 

A = Vmax * Kt / (Re * Rm + Kt * Kb) * 1 * k; 

10 pi = 1/Jm/Ie * (-Ie * Rm - Re * Jm + sqrt(Ie A 2 * Rm A 2 - 2 * Re * Rm * Ie * Jm 
+ Re A 2 * Jm A 2 - 4 * Kt * Kb * Ie * Jm)) / 2; 
p2 = 1/Jm/Ie * (-Ie * Rm - Re * Jm - sqrt(Ie A 2 * Rm A 2 - 2 * Re * Rm * Ie * Jm 
+ Re A 2 * Jm A 2 - 4 * Kt * Kb * Ie * Jm)) / 2; 

15 a = max(-pl ,-p2) 

b = min(-pl,-p2) 

% make initial guesses for step durations 

20 etl = 1; 

et2 = .005; 
et3 = 1; 
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% set maximum iteration count 
Nmax=1000; 



forj = l:Nmax 

% save old values of step time intervals 
30 et3old = et3; 
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et2old = et2; 
etlold = etl; 

% iterate for switch times using fixed voltage level Vmax 

et3 = -log(l .0 / 2.0 - exp(-etl * a) / 2 + exp(-et2 * a)) / a; 

et2 = 1/b * log(2.0) + 3 * et3 - 1/b * log(2 * exp(l/A * b * X) * exp(et3 
* b) - sqrt( 4.0) * sqrt(exp(l/A * b * X)) * exp(et3 * b) * 
sqrt(exp(l/A * b * X)+exp(et3 * b) A 2 - 2 * exp(et3 * b))); 

etl = -(-2* A*et2 + 2* A*et3-X)/A; 

if norm([et3old - et3 et2old - et2 etlold - etl], inf) <= eps * 2 
break 

end 

if j==Nmax 

error(['error - failure to converge after num2str(Nmax),' 
iterations']) 

end 
end 

% round up pulse duration to nearest sample interval, 

% convert to intervals between steps to make sure that voltage 

% requirements will not increase (beyond Vmax). 

dtl=ceil((etl - et2) / dt) * dt; 
dt2=ceil((et2-et3)/dt)* dt; 
dt3=ceil((et3)/dt)*dt; 

etl23 = [etl,et2,et3] 

% convert back to total step duration. 



etl =dtl +dt2 + dt3; 
et2 = dt2 + dt3; 
et3 = dt3; 

% In the following, the original constraints equations involving XF1, XF2, 
% and XF3 have been modified to include a variable voltage level applied 

at 

% each step (instead of the fixed maximum (+/-) Vmax). 

% The original equations for XF1, XF2, and XF3 follow: 

% XFitW,) - VoFi(t te „d - to) - 2VoFi(te„ d - ti) + 2V 0 Fi(W - 1 2 ) 

% XF 2 (t e „d) = V 0 F 2 (t t end - to) - 2V 0 F 2 (tend - ti) + 2V 0 Fi(te„d - t 2 ) 
% XF 3 (tend) = V 0 F 3 (t t e„d - to) - 2V 0 F 2 (t end - ti) + 2V 0 Fi(te nd - t 2 ) 

% And the modified equation including adjustable relative levels of 

voltage 

%L1, L2andL3are: 

% XFi(t 6 nd) = LiV 0 Fi(t tend - to) - LsVoFiCUd - ti) + L 3 V 0 Fi(W - 1 2 ) 
% XF 2 (t e nd) = LiV 0 F 2 (t t end " to) - L 2 V 0 F 2 (t end - ti) + L 3 VoFi(ten d - t 2 ) 
% XF 3 (t end ) = LiVoF 3 (ttend - to) " L 2 VoF 2 (te n d " ti) + L 3 V 0 Fi(te„d - t 2 ) 

% And the corresponding constraint equations are: 
% XFi(t e „d) = Finalpos 
% XF 2 (W> = 0 

% XF 3 (tend) = 0 

% Where all of the times indicated have discrete values, e.g. 
corresponding to 

% the controller update rate. 
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% It should be noted that after the digital switch times are fixed, the 
constraint 

% equations derived from the equations above form a linear set of 
equations in 

5 % the unknown relative voltage levels LI, L2 and L3 and any standard 

linear 

% method can be used to solve for the relative voltage levels. In the 
equations 

% for (LI, L2 and L3) that follow, the solution was obtained by algebraic 
1 0 % means (and are not particularly compact.) 

% compute new relative voltage step levels 
% LI, L2 and L3 are nominally assigned to "1", "-2" and "+2", 
respectively 

15 si = X * (exp(-et3 * b) * exp(-et2 * a) + exp(-et3 * a) + exp(-et2 *b ) -exp(-et2 
*b) * exp(-et3 * a) - exp(-et2 * a) - exp(-et3 *b )); 
s2 = 1 / (et2 * exp(-etl * b) * exp(-et3 * a) + exp(-et2 * b) * et3 * 

exp(-etl * a)- et2 * exp(-et3 * a) - et2 * exp(-etl * b) -et3 * 
exp(-etl * a) - exp(-et2 * b) * et3+exp(-et3 * b) * etl * exp(-et2 * 
20 a) + exp(-et3 * a) * etl + exp(-et2 * b) * etl - exp(-et2 * b) * etl * 

exp(-et3 * a) - et3 * exp(-etl * b) * exp(-et2 * a) - exp(-et2 * a) 
etl - exp(-et3 * b) * etl - exp(-et3 * b) * et2 * exp(-etl * a) + et3 

exp(-etl * b) + et2 * exp(-etl * a) + exp(-et3 * b) * et2 + et3 
exp(-et2 * a)) / A; 
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* 



LI - si * s2: 



si = 1 / (et2 * exp(-etl * b) * exp(-et3 * a) + exp(-et2 * b) * et3 * 

exp(-etl * a) - et2 * exp(-et3 * a) - et2 * exp(-etl * b) - et3 * 
30 exp(-etl * a) - exp(-et2 * b) * et3 + exp(-et3 * b) * etl * 
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exp(-et2 * a) + exp(-et3 * a) * etl+exp(-et2 * b) * etl - 
exp(-et2 * b) * etl * exp(-et3 * a) - et3 * exp(-etl * b) * 
exp(-et2 * a) - exp(-et2 * a) * etl - exp(-et3 * b) * etl - exp(-et3 * 
b) * et2 * exp(-etl * a) + et3 * exp(-etl * b) + et2 * exp(-etl * a) + 
5 exp(-et3 *b ) * et2 + et3 * exp(-et2 * a)) * X; 

s2 = (exp(-et2 * b) * exp(-etl * a) - exp(-etl * a) - exp(-et2 * b) - 

exp(-etl * b) * exp(-et2 * a) + exp(-etl * b) + exp(-et2 * a)) / A; 
L3 = sl*s2; 

10 si = exp(-etl * a) - exp(-et3 * a) + exp(-et3 * b) - exp(-etl * b) - 

exp(-et3 * b) * exp(-etl * a) + exp(-etl * b) * exp(-et3 * a); 
s2 = X / (et2 * exp(-etl * b) * exp(-et3 * a) + exp(-et2 * b) * et3 * 

exp(-etl * a) - et2 * exp(-et3 * a) - et2 * exp(-etl * b) - et3 * 
exp(-etl * a) - exp(-et2 * b) * et3 + exp(-et3 * b) * etl * exp(-et2 * 
15 a) + exp(-et3 * a) * etl + exp(-et2 * b) * etl - exp(-et2 * b) * etl * exp(- 

et3 * a) - et3 * exp(-etl * b) * exp(-et2 *a ) - exp(-et2 * a) * etl-exp(-et3 * 
b) * etl - exp(-et3 * b) * et2 * exp(-etl * a) + et3 * 

exp(-etl * b) + et2 * exp(-etl * a) + exp(-et3 * b) * et2 + et3 * 
exp(-et2 * a)) / A; 

20 

L2 = si * s2; 

% convert accumulated voltage steps to sequential voltage level 
VI = Vmax * (LI); 
25 V2 = Vmax * (LI + L2); 

V3=Vmax*(Ll +L2 + L3); 

% END OF PSEUDO CODE 
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APPENDIX B 



AREA .. SUM(I,A(I)) =E= 0; 

VELOCITY(VINDX) .. VEL(VINDX) =E= VSCALE * 
SUM(I$(ORD(I) LE ORD(VINDX)), A(I)); 

POSITION .. SUM(I,VEL(I)) =E= FINALPOS * SCALEFACT; 
VLIMITP(I) .. SUM(VINDX$(ORD(VINDX) LE ORD(I)),A(I- 
(ORD(VINDX)+l))*(VOLTS(VINDX)+KBACK*VSCALE)) 

=L= VOLTLIM; 

VLIMITN(I) .. SUM(VINDX$(ORD(VINDX) LE ORD(I)), A(I- 
(ORD(VINDX)+l))*(VOLTS(VINDX)+KBACK*VSCALE)) 

=G= -VOLTLIM 

% A(I) are the current commands at time T(I) spaced equally at time DT. 
% VOLTS(VINDX) is a table of voltages representing the unit pulse 
response to 

% a unit output in current command. VOLTLIM is the voltage limit at 
saturation. 
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APPENDIX C 



GOALPOS .. SUM(I,A(I)*MODELAA*DT) =E=FINALPOS; 
MODEl(ILAST) .. SUM(I,-A(I)*MODELAA*MODELb/(MODELb- 
5 MODELa)*(EXP(-MODELa*(T(ILAST)+DT-T(I))) 
-EXP(-MODELa*(T(ILAST)-T(I))))) =E= 0.0; 

MODE2(ILAST) .. SUM(I,A(I)*MODELAA*MODELa/(MODELb- 
MODELa)*(EXP(-MODELb*(T(ILAST)+DT-T(I))) 
-EXP(-MODELb*(T(ILAST)-T(I))))) =E= 0.0; 
10 DERIV1(J) .. 1000.0*SUM(I,A(I)*T(I)*EXP(ZETA(J)*W(J)*T(I))* 

SIN(WD(J)*T(I))) =E= 0.0 ; 

DEPJV2(J) .. 1000.0*SUM(I,A(I)*T(I)*EXP(ZETA(J)*W(J)*T(I))* 
COS(WD(J)*T(I))) =E= 0.0 ; 

1 5 % MODELAA is the mechanical gain of the system, MODELb, and MODELa 

% are the two time constants of the system in radians. One time constant is 
% associated with the L/R rise time of the motor inductance and the other is 
% the mechanical time constant of the rigid system. The A(I) are the voltages % 
which need to be determined. The T(I) are the times for each of the A(I). 

20 % DT is the time spacing of the outputs. W(J) are the undamped flexible 

% modes, WD(J) are the damped flexible modes (in radians/s). 



